#!/usr/bin/env python3

import time
import rospy
from DrRobotController_six_axes_can.msg import show_joint_x_position
# import DrRobotController_six_axes as dr

def callback(data):
    import DrRobotController_six_axes as dr
    print(dr.show_joint_x_position(id_num=data.id_num, n=data.n))
    rospy.loginfo("show_joint_x_position_node")


def listener():
    rospy.init_node("show_joint_x_position", anonymous=True)
    rospy.Subscriber("show_joint_x_position", show_joint_x_position, callback)
    rospy.spin()


if __name__ == '__main__':
    listener()

